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ABSTRACT 

Kinematic  modelling  of  a  robot  is  important  for  developing  position  control  algorithms  for  the  robots.  This 
paper  features  the  kinematic  modeling  of  a  5-axis  SCORBOT  ER  4u  stationary  articulated  robot  arm.  A  mathematical 
kinematic  model  was  developed  based  on  D-H  parameters.  The  kinematic  model  was  validated  experimentally ,  by 
comparing  reference  and  measured  wrist  positions  in  the  Cartesian  space. 
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INTRODUCTION 

"Robot  manipulator"  is  defined  as  a  chain  of  links  and  joints.  One  end  is  connected  to  ground,  and  at  the 
free  end  is  attached  an  end  effector  or  gripping  device.  It  is  assumed  that  a  link  is  a  rigid  body  [1].  The  problem  of 
kinematics  is  to  describe  the  motion  of  the  manipulator  without  consideration  of  the  forces  and  torques  causing  the 
motion. 

Robot  Kinematics 

There  are  two  different  ways  to  express  the  position  of  any  link:  using  the  Cartesian  space,  which  consists 
of  position  (x,  y,  z),  or  using  the  joint  space,  by  representing  the  position  by  the  angles  of  the  manipulator's 
links[2].  Forward  kinematics  is  the  transformation  from  joint  space  to  Cartesian  spacei.e.to  determine  the  position 
and  orientation  of  the  end-effectors  given  the  values  for  the  joint  variables  of  the  robot.lt  is  used  to  describe  the 
static  position  and  orientation  of  the  manipulator  linkages. The  transformation  of  the  position  and  orientation  of  a 
robot’s  end-effector  from  Cartesian  space  to  joint  space  is  termed  as  inverse  kinematics.Transformations  depends 
on  the  configuration  of  the  robot  i.e.,  type  of  each  joint,  link  lengths,  joint  positions  etc.). 

Scorbot  ER-4u 

The  SCORBOT-ER  4u  [3]  is  a  vertical  articulated  robot,  with  five  revolute  joints  as  shown  in  figure  1. 
With  gripper  attached,  the  robot  has  six  degrees  of  freedom.  This  design  permits  the  end  effector  to  be  positioned 
and  oriented  arbitrarily  within  a  large  work  space. 

The  Tool  Center  Point  (TCP)  of  robot  is  at  the  center  of  the  gripper  pads.  The  origin  of  the  coordinate 
system  is  at  the  center  of  the  robot  base  at  table  level.  A  robot  position  in  Joint  coordinates  is  defined  by  Base, 
Shoulder,  Elbow,  Pitch  and  Roll  angle. 
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Figure  1:  SCORBOT-ER  4u  Configuration 


A  robot  position  in  Cartesian  (or  XYZ)  coordinates  is  defined  by  the  distance  of  the  robots  Tool  Center  Point 
(TCP)  from  the  point  of  origin  (the  center  bottom  of  the  robot  base),  along  the  three  axes  and  the  Pitch  (P)  and  Roll  (R) 
angles  of  the  gripper,  specified  in  angular  units. 

The  robot  is  supported  by  RoboCell  3D  graphic  software  used  to  design,  create  and  control  simulated  industrial 
workcells.  RoboCell  (Figure  2)  fully  integrated  with  SCORBASE  robotics  programming  and  control  software. 


Figure  2:  Robocell  Interface  for  SCORBOT-ER  4u 

OBJECTIVE 

The  objective  of  the  paper  is  to  model  the  forward  and  inverse  kinematics  of  SCORBOT-ER  4u  and  validate  the 
kinematic  model,  experimentally. 

KINEMATIC  MODEL  OF  SCORBOT  ER-4U  ROBOT 

Kinematic  modeling  of  robots  requires  attaching  reference  frames  to  the  links  of  the  robot.  In  the  present  work 
Denavit-Hartenberg  notation,  which  is  a  popular  and  reliable  approach  for  attaching  reference  frames  to  spatial  kinematic 
chain  links,  is  used  for  kinematic  modeling  of  the  SCORBOT-ER  4u  robotic  manipulator. 
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In  order  to  describe  the  location  of  each  link  relative  to  its  neighbor,  a  frame  is  attached  to  each  link,  and  then  a 
set  of  parameters  is  specified  that  characterized  this  frame,  as  shown  in  figure  3.  This  representation  is  called  the  Denavit- 
Hartenberg  notation  [2]  discussed  in  following  section. 


In  this  convention,  each  homogeneous  transformation  is  represented  as  a  product  of  four  basic  transformations. 
The  four  quantities  0i9  a i?  di?  ai  are  parameters  associated  with  link  i  and  joint  i.  These  four  parameters  0i,  ai?  di  and  are 
generally  given  the  names  link  length,  link  twist,  link  offset,  and  joint  angle,  respectively.  These  parameters  of  Scorbot  ER 
4-u  [4]  [5]  [7]  are  given  in  the  Table  1. 


Table  1:  D-H  Parameter  for  SCORBOT  ER-4u 


Joint  i 

Uj 

di 

0i 

Range 

1 

16 

349 

-72 

0i 

-155°  to  155° 

2 

221 

0 

0 

02 

-35°  to  130° 

3 

221 

0 

0 

03 

130°  to  -130° 

4 

0 

0 

72 

04+72 

130°  to  -130° 

5 

0 

145 

0 

05 

-570°  to  570° 

Forward  Kinematics 

The  transformation  matrix  [5],  [6],  [7],  [8]  was  obtained  on  the  following  rotation/translation  axis: 

•  A  rotation  about  zt  axis  by  an  angle  0* 

•  Translation  along  zul  axis  by  distance  d,- 

•  Translation  by  distance  a t  along  x* 

•  Rotation  by  angle  a*  about  x*  axis 

=Tz(dX(d,K(a,)TM) 
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where  S0psin(0i)  C0?=cos(0z),  Sai=sin(a,), 


Ca,=cos(a,),  Sijk=sin(0,+  0;+  0*),  C,/7=sin(0,+  07+  0t) 


The  overall  transformation  matrix,  °T5  ='1\  lT2  2T3  3T4  4T5 


0  T  _ 


C,  0  -5,  fl[C[ 


5,  0  C, 


0  -1  0 

0  0  0 


lT  - 
L1 


C2  -5, 
52  C2 
0  0 
0  0 


a2C2 

a2S2 


1 T  - 

h  ~ 


C3  -S]  0  a]C] 
S3  C3  0  a3S3 


0  0  0  1 


T  - 


-s4  o  c4 
c4  0  s4 


%- 


C5  -Si  0  0 
S5  C5  0  0 
0  0  1  i 


Therefore  the  overall  transformation  matrix  T=  T. 


T=%  = 


QQ^2S4  ^5  SiQiC^  QQ J4  C, (<3]  +a2Q  +fl3C2j  +J5C234 

~~  ^234  (4  _  fl2^2  “  fl3^23  “  ^234) 

1 


-CC 

^5^234 


vr 

05^234 


(i) 


The  value  of  X,  Y,  Zi.e  the  Tool  Center  Point  found  from  last  column  of  transformation  matrix  as:  - 

X  =  C1  ( CLl  +  d2C2  +  ^3^23  ^5^234  )  (2) 

F  =  5'1(ai  +^2^2  +^3^23  +^5C234)  (3) 

2  $2^2  ^3^23  ^5^234^  (4) 


Pitch:  Pitch  (figure  4)  is  the  angle  of  rotation  about  Y5  axis  of  end-effector.  It  was  obtained  as  the  summation  of 
all  previous  joint  angles. 

Pitch  p  =  (92  +  93  +  04)  =  0234  (5) 

Inverse  Kinematics 

Tasks  to  be  performed  by  a  manipulator  are  in  the  Cartesian  space,  whereas  actuators  work  in  joint  space. 
Cartesian  space  includes  position  vector  and  orientation  matrix.  However,  joint  space  is  described  by  joint  angles  [2]. 
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The  transformation  of  the  position  and  orientation  of  a  robot’s  end-effector  from  Cartesian  space  to  joint  space  is  termed  as 
inverse  kinematics.  The  equations  of  joint  variables  in  terms  of  position  and  orientation  of  the  end-effector  was  to  be 
formulated.  There  are  three  methods  namely,  geometric,  algebraic  [7]  and  Iterative  solution  [4]  used  for  deriving  the 
inverse  kinematics  solution  [4]. 

For  SCORBOT,  Cartesian  space  is  defined  by  five  parameter  i.e  x,  y,  z,  roll  (P),  pitch  (y)  [8], [11], [12],.  For  joint 
parameter  evaluation,  transformation  matrix  is  constructed  from  five  parameters  in  Cartesian  coordinate  space.  For  that, 
rotation  matrix  is  generated  which  depends  on  only  roll,  pitch  and  yaw  of  robotic  arm. 

So,  the  total  transformation  matrix  is  as  follows :- 


SpPa  +  SaCpSr 

x“ 

(6) 

CpSa  ~  CaSpSy 

Cffict  +  W« 

CySp 

Y 

-cacY 

CySa 

-SY 

z 

0 

0 

0 

1 

After  comparing  the  transformation  matrix  (1)  with  (6),  it  can  be  deduced  that 
0i  =  a, 

^234  =  P> 

05  =  y 

So,  the  calculation  of  yaw  is  as  follow:  - 

a  =  0X  -  a  tan  2(x,  y)  (7) 


0234  =  a  tan  2( r13 ,  ±yj r232  +  r33  )  (8) 

Here,  atan2  is  used  because  its  range  is  [-7T,  7i],  where  the  range  of  atan  is  [-71 12,  n  /2]. 

Roll:  The  roll  y  =  05  is  derived  as  follows 

@5  =  a  tan  2(r12  /C234 ,  rx ,  /C234 )  (9) 

Yaw:  The  yaw  (a)  of  the  Scorbot  arm  is  defined  by  the  base  rotation  i.e  0i 

From  the  above  expression  it  can  be  seen  that  02,  03  and04  are  merged  in  0234.  In  order  to  calculate  them,  it  has  to  be 
decomposed.  The  following  geometric  solution  method  is  used  to  estimate  02, 03  and04. 
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From  the  above  representation  (Figure  5)  [4]  [17],  the  following  relations  were  derived. 

X1  =  V(x’  +  y=  andy  =z 

As  the  Pitch  Pitch  (5  =  #234  ,  Coordinates  X2  and  Y2  is  found  by  following  geometric  relation 

V=V-  d  Cos  and  Y2=Y+(L  sin  01U 

Similarly,  the  coordinates  for  X3  and  Y3  is  found  as  follows 

X3  =  X2~al  and  Y3  =Y 


When  the  law  of  cosine  is  applied  to  A  ABC,  03  is  obtained  as 

2  2  2  2 
(X3  +Y3  - a2-a3  ) 

cos  03  = - 

2fl2^3 

6:  -  a  tan  2(±yji  -  COS2  @3 ,  cos  03 ) 


(10) 


And  from  figure  7,  02  =  -(f)-  S 

02  =-atm2(Y3,X3)-atm2(a3  sin03,a2  +cos@3)  (11) 

Smce  dA=d2H-d2-a  (12) 

Matlab  program  was  written  for  calculating  the  forward  and  inverse  kinematics  developed  in  above  sections  of 
Scorbot  ER  4u. 

EXPERIMENTATION 

In  order  to  validate  the  kinematic  model,  measurements  in  terms  of  position  and  orientation,  must  be  taken  of  the 
end  effector.  For  the  development  of  the  programs  considered  here,  only  the  position  of  the  end  effector  was  taken  into 
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account. The  experimental  measurements  were  carried  by  mounting  the  robot  on  a  plane  white  board  as  shown  in  figure  6. 


Figure  6:  Experimental  Setup  Board 

The  workspace  was  divided  into  four  quadrants.  Different  positions  from  each  quadrant  were  selected  so  as  to 
cover  all  workspace  of  the  manipulator  arm  and  the  same  are  validated.  The  joint  angles  required  to  these  reference 
positions  were  calculated  using  the  developed  inverse  kinematic  model  in  the  previous  section.  The  calculated  joint  angles 
were  provided  to  robot  control  software  and  the  resulting  position  of  wrist  in  the  Cartesian  space  was  measured  as  shown 
in  figure  7. 


Figure  7:  Cartesian  Position  Measurements 

The  reference  positions,  the  calculated  joints  angles  and  the  measured  positions  are  tabulated  in  table  2  provided 
in  appendix. 

The  results  of  the  Cartesian  error  obtained  are  shown  in  the  figure  8  (a-c). 
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Robot  Configurations 


Robot  Configurations 

Figure  8:  Absolute  Percentage  Error  in  Cartesian  Coordinates 
(a)  X-direction  (b)  (a)  Y-direction  (c)  (a)  Z-direction 

The  maximum  percentage  error  found  in  X,  Y  and  Z  coordinates  was  7.03,  7.84  and  14.92,  respectively.  Whereas, 
the  minimum  percentage  error  found  in  X,  Y  and  Z  coordinates  was  0,  0  and  0.02,  respectively.  The  average  percentage 
error  in  X,  Y  and  Z  coordinates  was  1.7,  1.38  and  3.36,  respectively.  Thus,  the  negligible  values  of  average  percentage 
error  between  the  reference  Cartesian  positions  and  measured  Cartesian  positions  validate  the  kinematic  model  of  the 
articulated  SCORBOT  ER  4u  robot  manipulator. 

CONCLUSIONS 

Kinematic  modeling  of  a  robot  is  important  for  developing  position  control  algorithms  for  the  robot.  In  the  present 
work,  forward  and  inverse  kinematic  models  were  developed  for  Scorbot  ER  4u  robot  manipulator  and  validated 
experimentally.  For  this  purpose,  reference  coordinates  in  Cartesian  space  were  taken  distributed  in  the  four  quadrants  in 
X-Y  plane.  The  joint  angles  for  the  reference  coordinates  were  calculated  using  the  Inverse  Kinematic  model.  The  joint 
angles  so  obtained  were  provided  as  input  to  the  robot  controller  in  the  experiments,  and  the  resulting  positions  were 
measured.  The  negligible  values  of  average  percentage  error  between  the  reference  and  measured  wrist  positions  in 
Cartesian  space  validate  the  kinematic  model  of  the  articulated  SCORBOT  ER  4u  robot  manipulator. 
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Table  2:  Results  of  Inverse  Kinematics 


Reference 

Cartesian 

Coordinate 

(mm) 

Joint  Angles  by  IK 
(BSEPR  in  degrees) 

Measured  Cartesian 
Coordinate 
(mm) 

Absolute 
Percentage  Error 

X 

Y 

Z 

Thetal 

Theta2 

Theta3 

Theta4 

Theta5 

X 

Y 

Z 

X 

Y 

z 

334 

325 

337 

44.2 

-40.09 

48.03 

55.61 

0 

336 

326.69 

330.86 

0.60 

0.52 

1.86 

156 

582.5 

352 

75.04 

-0.03 

0.03 

-0.02 

0 

155.7 

582.68 

349.17 

0.19 

0.03 

0.81 

-206 

569 

352 

110.01 

-0.01 

0.02 

-0.03 

-0.03 

-206.4 

566.72 

349.05 

0.19 

0.40 

0.85 

-80 

124 

110 

122.69 

-32.53 

131.34 

0.2 

-0.03 

-78.7 

122.67 

106.11 

1.65 

1.08 

3.67 

-513 

65 

68 

173.11 

25.26 

-2.01 

22.32 

0.11 

-516.8 

62.44 

63.82 

0.74 

4.10 

6.55 

468 

144 

16 

16.93 

26.01 

10.37 

9.47 

0.11 

472.2 

143.75 

16.87 

0.89 

0.17 

5.16 

370 

0 

575 

0 

-90.02 

89.92 

0.04 

0.11 

382 

0 

570.54 

3.14 

0.00 

0.78 

500 

-290 

260 

-30 

26.77 

-26.85 

0.02 

0.11 

501.8 

-289.72 

249.92 

0.36 

0.10 

4.03 

248 

-295 

130 

-50.01 

0 

90.07 

-90.14 

0.11 

245.4 

-292.56 

128.18 

1.06 

0.83 

1.42 

116 

-503 

60 

-77.14 

17.55 

19.87 

0.22 

0.15 

115.1 

-504.18 

59.44 

0.78 

0.23 

0.94 

-21 

-138 

48 

-98.55 

-6.47 

96.68 

42.63 

0.15 

-20.2 

-134.59 

46.49 

3.96 

2.53 

3.25 

-73 

-226 

860 

-107.18 

-89.48 

37 

-0.02 

-0.1 

-71.2 

-230.2 

860.41 

2.53 

1.82 

0.05 

-306 

-463 

156 

-123.58 

4.86 

24.01 

3.29 

0.08 

-305.6 

-460.38 

146.32 

0.13 

0.57 

6.62 

-44 

-581 

264 

-94.35 

14.14 

-15.17 

18.96 

0.04 

-44.7 

-587.65 

254.31 

1.57 

1.13 

3.81 

-199 

-519 

246 

-110.92 

22.54 

-0.07 

-47.41 

0.04 

-198.5 

-519.28 

241.01 

0.25 

0.05 

2.07 

-268 

-394 

28 

-124.3 

16.66 

19.68 

25.79 

0 

-266.9 

-391.23 

26.39 

0.41 

0.71 

6.10 

-140 

-317 

306 

-113.58 

-67.33 

103.65 

25.81 

0 

-138.8 

-318.1 

293.74 

0.86 

0.35 

4.17 

-200 

-437 

120 

-114.32 

-5.99 

42.32 

25.81 

0 

-198.4 

-438.91 

112.83 

0.81 

0.44 

6.35 

-115 

-499 

514 

-102.46 

1.6 

-52.11 

53.54 

0.04 

-112.7 

-510.08 

505.71 

2.04 

2.17 

1.64 

-394 

-448 

361 

-131.12 

-0.01 

-0.02 

-0.01 

0.04 

-396.6 

-454.35 

349.26 

0.66 

1.40 

3.36 

0 

-598 

359 

-90.01 

0.02 

-0.05 

0.04 

0 

-0.1 

-603.12 

349.01 

0.00 

0.85 

2.86 

-47 

-406 

144 

-96.77 

1.85 

82.39 

-92.01 

0.08 

-47.5 

-400.05 

141.6 

1.05 

1.49 

1.69 

299 

-520 

357 

-60.03 

0.02 

-0.04 

0.03 

0 

301.3 

-522.48 

348.97 

0.76 

0.47 

2.30 

193 

-325 

573 

-60.03 

-90.08 

90.03 

-0.01 

0 

190.7 

-330.76 

570.34 

1.21 

1.74 

0.47 

101 

-216 

47 

-65.26 

-14.04 

93.86 

27.36 

0 

94.8 

-205.79 

46.44 

6.54 

4.96 

1.21 

327 

-401 

110 

-50.88 

28.13 

-22.75 

48.86 

0 

325.4 

-400.12 

106.32 

0.49 

0.22 

3.46 

515 

-50 

188 

-5.6 

7.7 

-3.26 

59.12 

0 

517.5 

-50.74 

172.34 

0.48 

1.46 

9.09 

365 

-136 

329 

-20.06 

-60.13 

84.87 

38.82 

0 

367.7 
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